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I. INTRODUCTION 


Future ballistic missiles may need the ability to ‘spin 
during boost ascent through the atmosphere asa counter- 
measure against first-generation continuous-duty laser 
threats. Since the conventional missile countrol design has 
uncoupled pitch, yaw and roll channels, some pertormance and 
even system stability may be lost in rollinj the missile. 
This study evaluates the performance of a conventional 
pitch-yaw controller in the presence of spin. A compensa- 
tion scheme is then proposed to restore system performance. 

The block diagram of a submarine-launched ballistic 
nissile's pitch-yaw control system is used as the design 
vehicle for this study. Since the physical parameters of 
this system are classified, only the block diagram is used 
in the analysis and design process. All numerical values 
needed tor analysis and Simulation are borrowed from other 
systems or derived as needed. 

The study is conducted as follows. First, the basic 
laws of motion and thrust vector control are introduced. 
Together, these sets of equations define the flight dynamics 
of the missile and the method for controlling the missile. 
The pitch-yaw controller for the non-rolling missile 1S then 
designed and Simulated. This system has uncoupled channels 
for pitch and yaw control which become coupled when the 
Bissile is rolled. Next, the missile is forced to roll and 
the effect cross-coupling has on the system's performance is 
analyzed. A compensation scheme 1S then proposed to restore 
the system's performance. Analysis and design are carried 
out using classical and modern controls analysis and 


simulation results are presented. 


A. MISSILE DYNAMICS AND THRUST VECTOR CCNTROL 
1. Notation and Reference Axis System 

The reference axis system used tc define vector 
quantities, dimensions and angles of interest is shown in 
Fig. 1-1. The axis system is fixed within the missile body 
with its origin at the  missile's center of gravity. The 
orthogonal axes, x, y and z, will also be referred to as the 
roll, pitch and yaw axes, respectively. Fig. 1-1 indicates 
that the right-hand rule is used to determine the positive 


directicn for rotaticnal vector quantities. 





BMq DON 
YV CNr 


Z ZW Velocity 


Fig. 1-1 Reference Axis System 


Table 1-1 lists the symbols used to refer to key 
parameters and quantities of interest. Cther symbols will 
te defined as they arise. The moments of inertia akout the 


center of gravity (cg) are defined as: 


A - 2 dm (y2+#z2) (1. 1) 
B = Z dm (z?*x?) (1.2) 
C = 2 dm (x2+y2) (1.3) 


The products of inertia are defined as: 


D = 2 (dm) yz (1.4) 
E = 2, (án) xz (1.5) 
FE = 2 (dm) xy (1.6) 


Where 2,dm symbolizes the sum of differential mass elements 


which make up the missile Etcdy. 


TABLE 1-1 
NOTATION CEFINITIONS 














mt lé im eee ce 


Roll Axis Pitch Axis Yaw Axis 


x y Z 


Component of missile 
| velocity along axis V w 
Component of force X y 2 
on missile along axis 
Mo E l 
ren acting omi L M N 
missile about axis 


Moments of inertia 


about each axis 


| Products of inertia D E F | 














2.  Euler's Equations of Motion 
Ihe equations of motion for a body with six degrees 
of freedom and a mass, m, are summarized below. A dot (») 
over any symbol refers to the time rate of change, d/dt, of 


the quantity indicated. (Ref. 1] 


n (U + qu - rv) = X (1.7) 
DV + LU - pw) = Y (1.8) 
m (w = gU + £v) = Z (1.9) 


Ap - (B-C)qr * D(r?-q2) - E(pqer) + E(rp-d) - L (1.10) 
Bq - (C-A)rp * E(p?-r2) - F(qr*p) * Dipq-r) = M (1.11) 
Cr - (A-B)pq * F(g?-p2) - D(rptq) * E(qr-f) = N (1.12) 


Ihe first three equations above are force equations 


and the second three are moment equaticns. In particular, 
Eqs. (1.11) and [1.12) are those from which pitch and yaw 
angular accelerations are found. Note that the second term 


in each of these equations constitutes a cross-coupling tern 
between the two channels which is proportional to the roll 
rate. This cross-coupling effect is «eliminated in the 
conventional pitch-yaw controller design by preventing roll 
and thus setting the roll rate, p, equal tc zero. 

Assuming that the missile body is approximately 
rigid leads to the conclusion that the products of inertia 
are equal to zero. Thus Eqs. (1.11) and (1.12) are reduced 


to: 


(1. 13) 


i 
E 


Bq - (C-A)rE 


(1.14) 


il 
Z 


Cr - (A-B)pq 


3. Thrust Vector Control 

Ihe only means used to control the flight cf the 
missile under study is to deflect the exhaust nozzle as 
shown in two dimensions in Fig. 1-2. fCeflecting the exhaust 
nozzle causes the driving force of the rocket motor tc be 
pointed in a direction other than along the missile's longi- 
tudinal axis. This action creates force Components 
perpendicular to the roll axis which do not act through the 
missile's center of gravity. The resulting moments are 
about the y- and z-axes and cause the missile to pitch and 
YAN < The monents about the center of gravity caused ty the 


deflected thrust vector are: 


NM = (Tz)1, (1.15) 


=z 
t 


Where l, is the length from the missiles center of gravity 
to the point of application of the thrust (exhaust nozzle) 
and Ty and T; are the lateral thrust components parallel to 
the y-axis and z-axis. If dg and dy are the angles of 
nozzle deflection in the pitch and yaw planes, then the 
perpendicular thrust components are related to the tctal 
rocket motor thrust by the following equations: 


T-sin(dy) (1. 17) 


K 
NES 
y 


rj 
N 
u 


I:sin(dg) (1.18) 
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Fig. 1-2 Thrust Vector Control 


Assuming that the maximum angle of nozzle deflection 
is small, as it must be for any physical systen of this 
type, permits further simplification of Eqs. (1.15) and 
(1.16) to the linear Egs. (1.21) and (1.22). 


(1.19) 


ue 


i? 


Sin(dy) — dy (1.20) 
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M = 1-dg* 1, (1.21) 
N = T-dy* 1 (1-22) 
Equations (1.21) and (1.22) give the moments in 


pitch and yaw caused by the rocket motor. Combining these 
two equations with the general rotational motion equations 
in pitch and yaw, Eqs. (1.13) and (1.14), permits formula- 
tion of the general differential equations for pitch and 


yaw- 
T-dg- 1, = B9 - (C-A)rp (1.23) 
T:dy'lo = CE - (A-B)pq (1.24) 


Solving for the angular acceleration components gives: 


(1/B)[T:dg:l, * (C-A)rr] (1.25) 


Ver 
it 


(1/C)[T-dy'l, + (A-E) pq] (1.26) 


B 
H 


Equations (1.25) and (1.26) point out the cross- 
coupling effect that the roll rate, p, has on the system. 
For instance, if the roll rate is set equal to zero the 


equations for pitch and yaw are completely uncoupled. 


A UI. (1.27) 


rie 


(1/C) T+ dy’ 1, (1.28) 
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Figure 1-3 depicts the rolling pitch-yaw system just 
described in block diagram form and highlights the cross- 
coupling terms introduced by roll. The classical missile 
control system design approach assumed that the roll rate 
was small and went tc great lengths to ensure this was true. 
Making the assumption that the roll rate is negligible 
allows the system designer to separate the pitch and yaw 
channels and deal with them independently. This study will 
analyze the effect cross-coupling has cn stability and 
performance and formulate a compensation scheme for the 


cross-coupled syster. 





mm menne 








8 8 
Roll 
Cross-Coupling | : 


Fig. 1-3 Thrust Vector Control Dynamics 
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II. DEVELOPMENT OP THE NON-ROLLING MISSILE 


The strategic missile whose pitch-yaw control systea 
will be used as the design vehicle for this study. The 
block diagram of the system's pitch-yaw control system 
(without roll) is shown in Fig. 2-1. Since the physical 
parameters of this missile are classified, only the block 
diagram will be used. All system constants and physical 
parameter values which are used for analysis and siaulation 
will te taken from other systems or derived as needed. 

The missile is a three-stage booster rocket. Flight of 
the missile 1s controlled by vectoring the exhaust thrust as 
described in the preceding section. Based upon predeter- 
mined flight trajectories and measured or estimated parane- 
ters duriug flight, the guidance computer generates pitch 
and yaw commands and transmits these to the pitch-yavw 
controller [Ref. 2]. The algorithm which the guidance 
computer uses to generate the pitch and yaw commands will 
not te addressed. Only the response of the pitch-yaw 
contrcller to a general set of commands will be considered. 

Table 2-1 lists the physical parameter values used at 
the various stages for design and simulation. These parare- 
ters bear no resemblance to those of the Trident [I missile 
but serve only to provide actual nunbers for the variables 
so that simulation could be done. The parameters listed ina 
Table 2-1 were actually taken froa the Saturn Y Rocket; also 
a three-stage booster rocket, The moments of inertia listed 
in Table 2-1 were obtained from the other parameters by 
assuming that each stage has approximately the same inertial 
characteristics aS a uniform right-circular cylinder. 
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Fig. 2-1 Non-Rolling Pitch-Yaw Control System 


Figure 2-1 shows the schematic block diagram of the 
System used to control pitch and yaw in the missile. Since 
the missile does not spin, the pitch and yaw channels are 
uncoupled. The system consists of a Servo-actuator used to 
deflect the exhaust nozzle, the missile dynamics and sensors 
which feed back angular velocity and position. The deflec- 
table exhaust nozzle saturates at a maximua deflection of + 
five degrees. In this analog system all gains are constant 


throughcut operation. 
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TABLE 2-1 


PHYSICAL PARAMETER SPECIFICATIONS 


sa a aS SS Se te et ee A cm me ee See ee 


ist Stage end Stage 3rd Stage 


1.488x10? | 3.22x10 8.14x10° 


Initial Mass 





Mass Rate slug/sec 81.49 1497 


HH 


Thrust lb 7.496x10 1.125x10? | 2.249x10? 


Lac) 
NO 
NN 
© 
E s 
d 


Length ft 133 130 100 
Burn Time sec 150 135 ATG 


homent of Inertia 


about Pitch Axis m(1476.4) | m(858.3) 


Ne re m( 1542.1) 


Moment of Inertia 


&bout Yaw Axis m(1476.4) m(858. 3) 


stu m(1542.1) 


Re me s SÓ Ms Ge GR Es Ge ie 


Moment of Inertia 


about Roll Axis slug-ft m(136.1) m(136.1) m(50.0) 


po 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
| 
i 
| 
| 
| 
i 
| 
| 
| 
| 
| 


A. DESIGN OF THE SERVO-ACTUATOR 
The transfer function of the  servo-actuator which 


deflects the exhaust nozzle of the missile is given in Eq. 


12.1). The task is to select nuaerical values for the 
parameters, a, b and f, such that the servo-actuator has 
acceptable performance characteristics. Again, the param- 


eter values vill be selected without regard to those used on 


the actual missile. 


dels) _ ab? (2.1) 
E, (5) (s * a) (s? * 2£bs + be) 


It is desired that the actuator's performance resenble 
that ct a well damped second-order system with sinimun over- 
shoot and a short settling tiae in response to step inputs. 
These performance characteristics need to be more stringent 
than those imposed on the entire system so that the actuator 
does not become a limiting elesent when the entire systea is 
considered later. The design specirications used for the 
actuator are summarized as follows. 

1. Pole Locations 

In order to ensure that this third-order systen 
behaves essentially as a second-order system, the real pole 
must have a magnitude signiricantly greater than the real 


part of the complex roots of the second-order tern, e.g. 
a > 10£b (2.2) 


2. Damping 
In order to make the dominant coaplex pair of poles 
exhibit good damping, the value ot f must approach one. 


5r »058 (2.3) 
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3. Settling line 

In order to keep the actuator frou lisiting the 
settling time of the entire system, the servo's settling 
time must be significantly shorter than that of the pitch- 
yaw controller. If the desired settling time of the entire 
System is to ke approximately ten seconds and the actuatocr's 
settling time is 3% of the system's, then the actuator's 
settling time will be selected according to the relaticnship 





below. 


< 0.03 t (2.4) 


settling Servo settling system 


lU. Eeak Cvershoot 


The peak overshoot of the servo-actuator must be 
small. Otherwise, it may have an appreciatle effect on the 


overall system's peak overshoct. 
M(servo) - 1 < 1% (2.5) 


Where M(servo) is the peak overshoot of the actuator. 
Equation (2.5) permits selection of the appropriate 

damping ratio, PS If the system is assumed to exhibit 

second-order characteristics, then Eq. (2-6) can be solved 


for the damping ratio. 


M(servo) - 1 -» exp m | « 0.01 (2.6) 
1-f 


Solving for the damping ratio, f, yields the following. 


f > [1n(0.01)]2 - 0.826 (2.7) 
q? * [1n(0.01) J? 


So, a damping ratio of 0.9 will be used. This selection 


also satisfies Eq. (2.3). 
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The specification of Eq. (2.4), combined with the 
above choice of damping ratio, can te used to select the 


natural frequency of the second-order tera. 


t settling servo - +] < 0.3 sec (2.8) 
fb 
Solving for the natural frequency leads to a selection of b 


equal to 15. 
b» 14.8 rad/sec (2.9) 


Equation (2.2), combined with the above choices of 
damping ratio and natural frequency, leads to a selecticn of 


the real pole, a, equal to 150. 
a > 10ft = 135 (2.10) 


The root locus of the system's characteristic equa- 
tion, obtained by varying the real pole, a, is shown in Fig. 
2-2 Highlighted are the root locations for the above 
choice of parameter values. As shown in Fig. 2-2, all the 
roots are well into the left half of the s-plane, a large 
phase margin exists for the second-order complex pole fair 
and the second-order pair is far enough to the right cf the 
Single real pole to achieve doginance. Figure 2-3 shows the 
open-loop freguency response of the actuator and takes the 
large phase margin more evident. Figure 2-4, the closed- 
loop frequency respcnse, points out the linitation of the 
actuator to follow input signals of frequency greater than 
about 10 radians/second. Figure 2-5 shows the ste response 
of the system and as indicated, it meets the design specifi- 
cations. Note that although the simulation shown in Fig. 
2-5 is that cf a full step cf unit magnitude, the nczzle 
actuator saturates at a maximum angle of deflection of 


0.0873 radians (5 degrees). 


19 


73.0 


Stability Crossover 
ab? = 7.57 x 10 


eevee .. ..QL0n0..Lroo 
. 


50.0 


sinpz p= 0.95 


23.0 


0.0 


. 
. ts. 
LJ 


-25.0 


-50.0 


-78.0 





-100.0 


-180.0 -140.0 -120.0 -100.0 -B0.9 -00.0 -40.0 -20.0 0.0 £0 


Fig. 2-2 Servo-Actuator boot Locus Elot 


Figure 2-2 shows that the magnitude of the real pole 
is far greater than the real part of the complex pair and, 
therefore, will have little effect on the system's perform- 
ance. Also, the dominant seccnd-order pair is «ell darped 
with approximately a 72-degree phase margin and an effective 
damping ratio of 0.95. The system is stable as long as the 


tern, ab?, remains less than 7.57 x 105. 
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B. DESIGN OF THE PITCH-YAW CONTROLLER 

Ihe block diagram of the pitch-yaw control system is 
shown in Fig. 2-1. Since the pitch and  yaw channels are 
identical and decoupled only one of them need be considered. 
The parameters K, (KL, ) and K (Ky) will be selected so 
that the system will exhibit minimal overshoot to step 
inputs and have a settling time less than ten seconds. The 


one-channel system to be considered is shown in Fig. 2-6. 


LL EEE D a E | 
* 
* 


K,,S +1 


6 s > 
(s+a)(s°+2fb+b°) 
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Fig. 2-6 Pitch or Yaw Channel Blcck Diagran 


In order to begin the analysis, it is necessary to 
temporarily ignore the nonlinear saturation of the servo- 
actuator. The linearized transfer function for the pitch- 


yaw control syste then becomes that of Eg. (2.11). 





Ə (s) = K,ab2Tl, /E (2.11) 
Gc (Ss) SS * s*(a*2fb) * s?(b?*2fba) * s? (ab?) 


t S(K,, K,aE?11,/B) + K, ab?T1, /E 


ihe denominator of Eq. (2.11), when set equal to zero, 
defines the systesz's characteristic equation. The charac- 
teristic equation may be partitioned as follows. Define a 


new variable, J. 
J = ab2K(T1 /B) (2.12) 
The characteristic equation now tecones; 


s5 + ss (a+2fb) + <3(b2+2fba) (2. 13) 
+ s? {ak2) + S(Fra JJ) + J = 0 


Bearranging yields the partitioned form shown telow. 


os t! = -1 (2. 14) 
SS « s*(a*2fb) * s3(b2*2fba) * s? (ab?) E 


Equation (2.14) is in the form for root locus analysis 
where J 1s treated as the open-loop gain and the left side 
Of the equality as the open-loop transfer function. Varying 
Krg and J together sweeps out a region in the s-plane into 
which the roots of the characteristic equation can be 
located. These "root relocation zones" are shown in Fig. 
2-7. [Ref. 3] 

Figure 2-7 was made by varying J and Kre in Ege (2.14) 
and plotting the root locations. For example, if Kre= 0 
then Eq. (2.14) contains five finite poles and five zeros at 
infinity. The rcot locus will follow the path indicated in 
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Fig. 2-7 (as J increases). Note that the real pole at -150 
is not shown in Fig. 2-7. AS Kre is increased incrementally 
from zero towards infinity and the sane procedure is used, 
i.e., plot the root locus over a large (positive) range of 
J, then a family of root loci will be swept out. The cross- 
hatched area in Fig. 2-7 is the area enlosed by the root 


loci for J and K,, varying from 0 to co. 
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Fig. 2-7 Root Relocation Zones of Pitch-Yaw Controller 
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Figure 2-7 indicates that the system is unstable, with 
two roots in the right half-plane, for values of Kao less 
than or equal to zero. The values of K,, and J are esti- 
nated as 0.8 and 1.57 X 105, respectively. This selection 
locates the characteristic equation rocts as shown in Fig. 
2-8. The open-loop gain, K,, was found, from the definition 


of J, to range between the values shown below. 


Ist Stage 2nd Stage 3rd Stage 
1.071-0.07 1.51-0. 14 1.45-0. 19 


Exact solutions for K, and K,g were not obtained analyt- 
ically since the system contains a nonlinear saturation 
effect which was ignored in constructing the root locus. 
Also, K, is a function of system parameters which change 
continuously during flight and dramatically at bocster stage 
separations. lo fine tune the selection of K, and Koe?” 
simulation studies were conducted using DSL/360 during each 
of the three booster stages of operation. The results of 
the simulations, for various values of near are shown in 
Figs. 2-9, 2-10 and 2-11, where 8 is given as a function 


tine. 
The simulations illustrated that the gain, Rye has 
little effect on the system's performance. This 1s because 


it is "upstream" from the saturated nozzle actuatcr and, as 


such, can only shorten the time required for the actuator to 


reach maximum deflection. Since this tire is already small 
compared to the system's response, K has negligitle effect. 
To simplify the protlen, Kg was set equal to cne. The 


velocity feedback gain K,, has a pronounced effect on koth 
the overshoot and the settling time of the system. From the 
Simulations, Kg was selected to be 1.5. This choice 
ensures the specified settling time of ten seconds during 
all stages and resultS in overshoot only during stages one 


and two, where it is less than ten percent. 
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III. EFFECT OP ROLL 


When the non-rolling pitch-yaw control system just 
designed is forced to roll, the system becomes cross-coupled 
as shown in Fig. 3-1. The mechanism which creates and main- 
tains the rolling motion will not be considered., It is 
assumed that a control system outside the pitch-yaw 
controller and independent of the main thrust motor main- 
tains an approximately constant roll rate, p. Furthermore, 
it is assumed that the roll rate can Ee measured during 
flight or estimated from reasured parameters with reasonable 
accuracy. The purpose of this section is to analyze the 
effect roll has on the previously non-rolling fitch-yaw 
controller. 

Ihe Laplace transformations of the linearized  non- 
rolling system's governing differential equations can te 
written as two separate equations; one for the pitch channel 


and one for the yaw channel. 


GO (3. 1) 


s29 + GK ,.,58 * G8 z 


s2y + HK, ys? + HV - HY, (3.2) 
Nhere G and H are defined as: 
G = ton. ab? | (3.3) 
(s*a) (s? *2fEs*b?) 
i = Key ©) | ab? | (3.4) 
{sta) (s2+2fbs+t2) 


te "|— <" er. p —À—— 0 — — — "P — RÀ lw ME. AO AO. CADERA <A Sa a N 
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Fig. 3-1 Rolling Pitch-Yaw Controller Block Diagran 


Equations (3.1) and (3.2) can be rearranged and put into 


matrix form as shown in Eq. (3.5). Note that the equation 
has only diagonal non-zero elements and is, therefore, 
uncoupled. 
s2+GK res+G 0 | E = G 0 N (33 
0 s2+EKyy s+H T 0 HI (Ye 


Rolling the  rissile leads to the addition of cross- 
coupling terms between the equations governing pitch and yaw 
response. The transformed differential equations governing 
the responses of the rolling system are: 


s20 + GK, s@ + GƏ + QsŸ = GO (3.6) 


s2Y + BKrysY + HY + Rs68 = Re (3.7) 


Nhere G and H are defined in Egs. (3.3) and (3.4) and Ç and 
R are defined in Eqs. (3.8) and (3.9). 


(A - C)E/E (3-8) 


c» 
H 


(E - A) psec (3-3) 


D 
i 


Rearranging Eqs. (3.6) and (3.7) into matrix form as tefore 
leads to the coupled form: 


S2*GK., S*G Cs lo 6 0)[8 (3. 10) 
Bs S? «HR, S*H x 0 H Ve 


Equation (3.10) shows that the introduction of roll has 
affected the transfer functions which determine the input- 


to-output relationships of the system in twe ways. First, 
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it has changed the direct path transfer functions of 
pitch-to-pitch and yaw-to-yaw command-to-output. Second, 
roll has introduced  pitch-to-yaw and yaw-to-pitch consand- 
to-output transfer functions which were zero before the 
missile was forced tc roll. Ihe effect that these changes 
have on the systea*s stability and performance will be exam- 


ined next. 


A. EFFECT OF ROLL ON SYSTEM STABILITY 

As pointed out, the rolling system is governed Ey four 
transfer functions (2 inputs x 2 outputs). Consider cnly 
the pitch-to-pitch input-to-output transfer function, 1i.€e., 
hold the yaw-cowmand input equal to zero and igncre the yaw 
output. Under these conditions, the block diagram of the 
System may be rearranged as shown in Fig. 3-2. The transfer 
function obtained from the diagram is given in Eq. (3.11). 
As indicated, the pitch response of the system is influenced 
by à variety of system parameters, as it was before the 
missile was rolled. Now, however, the roct locations of the 


System are also affected by the roll rate. 





8 (s) = N5s9+NyS%+N3S3+N¿5S2+NyS+NO (3.11) 
8, 1s) S!0* D9s9*Dgs9*D,S? *Dcs$*DosS«D,s* 


*D s3¢D, s2+L, s + Do 


“where; 

Ns m (aD2/B)I1. Ko 

N, = (ab2/B)11,K,{a+2£b) 

Nz = (ab2/B)T1,K, (b2+2fba) 

N, EE(3b*7/B)31. K, (ab?) 

N4 = (ab?/B) TALE ¿(K,, Kyar2T1 /C) 
No = (at?/B)TL K (Kyab*T1l /C) 


2(a*Zfb) 


iP 
i 
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D 3 


D4 


2(b2+2fba) + [ (A-B) (A-C)E2/CB] + (a+2ft)2 = Day + Dg, p? 


2ab? * 2(a*2fb) (b?*2fEa*[ (A-B) (A-C) p?/CB]) = D74 + D72 p? 


(b2¢2fba) (b2¢2fba + 2[ {A-E) (A-C)p2/CE)) 
+ (abeti Ii (K,,E,/C)+ (Ko K, /B)] + (a*2ab) (2ab?) 
+ [ (4À-B) (A&-C) p?/CB] (a*2£E)? = D, + Iko F? 


(ab*Tlo)[ (KaG/B) * (K^/C) ] * 2[ (A-B) (4-C) E?/CB] (ab?) 
* 2(b2*2fba) (ab2) + 2[ (A-B) (A-C)p2/CE](b2+2f£ba) (a+2£b) 
* (a*2fb) (aE?Tl, )[| (Kry Ky/C) # (Kro Ke/EB) ] = D54 + D52 p? 


(ak2T1,)[ (Ky/C) + (Kg /E) ]{a+2£b) 
+ 2[ (A-B) (A-C)p2/CB](a+2fb) {ab2) 
+ [(KzyKy/C) * [Kro Ko/E).] (ab2T1¿) (b2+2fba) 
+ [ (A-B) (A-C) p?/CB](t2+2fba)2 + (at?)2 = D,, + D, p2 


[ (Ky/C) + (K/B) ](ab2TL ) (t2+2fba) 
* 2[ (A-B) (A-C) p?/CB] (aE?) (b?*2fba) 
+ [ (Kt, ,FK,7/C) + (Keo Ko/E) J((ab?1l; )ab?2) - D34 * Dzop? 


[ (K4/7C) * (K /E) ] (ab?) (ab*11 .) 
+ [ (A-B) (A-C)p?/CE j{at2)2 
+ LA LRYKS K, / BC) (TI1,at2)2 = Dau Tt Daa D 


Ko (ab? T1; /CB)?Rr, Ky * KroK elab?T1¿/CE)?Ky 


[ (Ky K,) (ab?71 ) 2 J/CB 


rn 
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AA A 


The denominatcr of Eq. (3.11), when set equal to zero, 
defines the characteristic equation of the system. 
Examination of Eq. (3.12) (in which Eq. (3.11) defines the 
coefficients) shcws that as the roll rate is increased from 
zero, the roots of the characteristic equation will move as 
a functicn of the squared rcll rate. For analysis, the 
region of operation will ke restricted to the beginning and 
end of each booster stage. At these instants, the charac- 
teristic equation is as given in Eq. (3.12) with numerical 
values for the coefficients given in Table 3-1. The end of 
stage three is not considered because the missile is no 
longer performing ¡powered flight at the end of the final 


stage. 


S10 * D9sS? * (Dg4*Dgop?)s* + (D54 tDzop?) s? 13.12 
+ (U61 *Doop?)s$ * (Ds 4 *Dso Er?) s^ * (Dy, +Dyo pe)s* 
+ (D 34t D32 p2)s3 + (Do4*i55 p?)s? * D4s + Dy = 0 


The "migration" of the system's roots as the rcll rate 
increases from zero is shown in Figs. 3-3 through 3-12. 
Figure 3-4, for example, shows that two roots of the system 
move into the right-half plane at a roll rate of approxi- 
mately 12.2 radiars/second. Since the linearized character- 
istic equation was used to construct the root loci shown in 
Figs. 3-3 through 3-12, the precise value cf roll rate which 
causes instability cannot te determined from the figures. 
What the figures point out is the general migration cf two 
System roots into the right-half plane in all phases of 


operation as the roll rate is increased. 


J8 


TABLE 3-1 


CHARACTERISTIC EQUATION COEFFICIENTS 








2nd Stage 3rd Stage 





lst Stage 











| Beginning End Beginning End Beginning 


Dy |354.0 354.0 354.0 354.0 EA 
Da, |39,979.0 39,879.0 39,879.0 39,879.0 39,879.0 
020755 0.9755 0.9401 0.9401 0.8869 
| 6 e c 6 6 
D.,, |1.5809x10 1.5809x10 1.5809x10 1.5809x10 1.5809x10 
Ip 345.33 PPS 332.80 332.80 313.96 
| 7 7 7 7 
|D] 3.0355x10 3.0725x10 3.0368x10 3.0751x10 3.0549x10 
[Dc |38, 902.0 38,902.0 SONO 37,490.0 35,368.7 
| 
8 8 8 8 8 
D-.13.1199x10 3.7781x10 3.1434x10 3.8236x10 3.4650x10 
6 6 6 6 6 
De 18542x10 1852210 1.486x10 1.486x10 1.402x10 
| > 
9 9 9 9 9 
D,,|1:7182x10 3.3458x10 1.7764x10 3.4584x10 2.571x10 
7 7 | 7 7 
D, | 2-9483x10 2.9483x10 2.8413x10^ |2.8413x10 
|... 4.8252x10^ |1.8385x10 © |s.310x10?  |1.9324x10l? 
| 8 8 8 8 8 
[D3> 2.815x10 2.815x10 2.7128x10 2.7128x10 2.5593x10 
1 I 1 | 
PA 7.311x1lo" 8.2761x10 ? 8.5265x10" 8.1567x10 C 3.389x10 U 
9 
D 1.11x10? 1.11x10? 1.0708x107 1.0708x10> 10102510 
10 | 
UA 5.794x10" 9.5278x1010 |7.0162x10? lo.292x10%0 NEMO 
10 9 
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Fig. 3-3 Root Migration at Beginning of First Stage 


Figures 3-3, 3-5, 3-7, 3-9 and 3-11 show how the roots 
of the characteristic equation of the rolling missile move 
as the roll rate is increased. A close-up view of the 
migration around the imaginary axis is shown in Figs. 3-4, 
3-6, 3-8, 3-10 and 3-12. 
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Stability Crossing p = 12.5 
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Fig. 3-8 Beginning of Second Stage Root Migration Close-Up 
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B. EFFECT OF ROLL ON SISTEN PERFORMANCE 

As shown, the introduction of roll into the pitch-yaw 
controller causes a migration of two system roots into the 
right-half of the s-plane. As the rocts approach the isagi- 
nary axis (as the roll rate is increased) the system begins 
to show Bore transient oscillation due to the decreased 
damping ratio. Ihe settling time of the system is also 
increased. Since the system contains tbe nonlinear satura- 
tion effect of the nozzle actuator and is of such high order 
(tenth), not much more than this qualitative observaticn was 
done analytically. 

To study the effect cf roll on system performance, a 
Series of simulation studies was conducted with the satura- 
tion effect present. The simulation studies were performed 
by subjecting the system to three sets of step-input 
commands and constant roll rates. The first study consisted 
of giving the system a step-pitch input and a zero-yaw input 
and observing the transient response at six roll rates 
between 2.5 and 15 radians/second. The results of these 
simulaticns are plotted in Figs. 3-13 through 3-18. The 
second study involved subjecting the system to a zero~pitch 
input and a step-yaw input and conducting the same tests as 
the first study. The results of the second study are 
plotted in Figs. 3-19 through 3-24. Finally, the systes was 
given both a step-pitch command and a step-yaw ccumand and 
the tests were repeated. The responses of the system to the 
conditions of the third test are shown in Figs. 3-25 through 
10: Unlike the non-rolling simulations which were run at 
separate booster stages (Figs. 4-9. through 2-195 the 
rolling simulaticns were run over several consecutive 
booster stages. This is because the settling time cf the 
rolling missile system was often greater than the burn time 


of a single stage. 
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Fig. 3-13 Pitch-Step Response at Roll Rate of 2.5 rad/sec 


Figures 3-13 through 3-18 show the system's pitch and 
yaw responses to a pitch-step input and a zero-yaw input at 
the specified roll rate. Note the dramatically increased 
overshoot, oscillation and settling time ccmpared to the the 
non-rolling simulations, Figs. 2-9 through 2-11. Figure 
3-18 shows shows the unstable response obtained at a roll 


rate equal of 15 rad/sec. 
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Fig. 3-14 Pitch-Ster Response at Roll fate of 5.0 rad/sec 
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Fig. 3-15 Pitch-Step Response at Roll Rate of 7.5 rad/sec 
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Fig. 3-16 Pitch-Step Response at Roll Kate of 10.0 rad/sec 
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3-17 Pitch-Step Response at Roll Rate of 12.5 rad/sec 


Un 
un 


2.0 


Pitch Response 


%oteomressesetensse eee. teases 
. 


1.5 





1.0 


. + * 
LN 1 . ste eme tes se esse 1 00 08 © + © : et. 0... meteceeeteess et toto em 099090908985 08 0989090459» O* 001.2 + 
. . 


RESPONSE (RADIANS) 
0.0 0.5 


Y . 
85069 99-80 *9 muy «00000090... ...00:.:..u..k 
. 


. 
* 


-0.5 


-1.0 





0 50 100 160 200 250 300 380 
TIME (SEC) 


Fig. 3-18 Pitch-Step Response at Roll Kate of 15.0 rad/sec 
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Fig. 3-19 Yaw-Step Response at Boll fate of 2.5 rad/sec 


Figures 3-19 through 3-24 show the system's pitch and 
yaw responses to a yaw-step input and a pitch-zero input at 
the specified roll rate. In these simulations, as in the 
previous ones, the overshoot and settling tire are increased 
above that observed in the ncn-rolling simulations of Figs. 
253 through 2-11. Figure 3-24 shows the unstable resronse 


at a roll rate of 15 rad/sec. 
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Fig. 3-25 Pitch- 8 Yaw-Step Response Roll Rate 2.5 rad/sec 


Figures 3-25 through 3-30 show the system's pitch and 
yaw responses to pitch- and yaw-step inputs at the specified 
roll rate. Under these conditions, the under-damped oscil- 
lation observed in the two previous test is even  uore 


pronounced. 
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3-30 Pitch- 


Fig. 


The simulation studies showed that the systes begins to 
reach instability at a roll rate of approximately 12 
radians/second. However, at roll rates as low as 2.5 
radians/second the system's performance has been severely 
degraded from the non-rolling case (Figs. 2-9 through 2-11). 
In all cases, the maximum peak overshoot is increased Ly a 
factor of at least five and the settling time by a factor of 
at least eight. The system's performance is approximately 
that of an under-dasmped oscillator. This response is caused 
by the two roots which have moved close to the imaginary 
axis as the roll rate was increased and are dominating the 
system's transient response. In the next section, a compen- 
sation scheme is proposed which increases the damping of the 
System and partially cancels the cross-coupling acceleration 


terms introduced ty roll. 
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RD eum O AA o ED E ee a ae op 


In the preceding chapter it was noted that rclling the 
missile had the effect of introducing cross-coupling terms 
into the pitch and yaw angular acceleration equations (Eqs. 
(3.6 and  (3.7)). In order to completely restore the 
syster's performance to its non-colling condition, it is 
necessary to eliminate or cancel out the cross-coupling 


terms. Equation (3.10) can be rearranged into the forn: 


s? Qs 9 |= G (8, = Ko S9 - 8) (4.1) 
RS — s? T H(Yo 7 Keys - V) 


The left side of Eq. (4.1) contains the "dynamics" of the 
systen. In other words, it gives the acceleration and 
velocity terms which determine the angular acceleration in 
the pitch and yaw channels. jhe only way to eliminate the 
cross-coupling terms directly would be to make changes to 
the left side of Eq. (4.1) which would cancel the terms, Qs 
and Bs0. This would involve dramatic changes to the missile 
body, thrust vector control system and flight performance 
and, therefore, will not be attempted. 

The right side of Eq. (4.1) constitutes the  "elec- 
tronics" of the system. It contains a sum of those terms 
which are added at the feedback junction then passed through 
the nozzle actuator. This side of the equation can be 
changed easily by altering the electronic network that makes 


up the feedback lcop. 
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A. CROSS-CHANNEL FEEDBACK 

Assume that the pitch rate and yaw rate can be accu- 
rately measured or estimated at any tige during flight. 
Also, assume that the terms, G; H; (C and BE, all functions of 
System parameters, can be measured or estimated accurately. 
Then, addition of the feedback terms cf pitch-rate-to-yaw- 
input and yaw-rate-to-pitch-input permit cancellation of the 
cross-coupling terms. The block diagram realization of the 
proposed change is shown in Fig. 4-1. Equation (4.2) gives 
the compensated system's transformed differential equation 


in matrix form. 


s? e E. aps EE ISLAS ECS VC) (4-2) 
Rs s? i Hie: n NEC RSS) 


Equation (5.2) can be reduced to Eq (5.3) by canceling 
the cross-coupling terms, Qs and RsQ, from both sides of 
the equation. Comparison of Eq. (4.3) with Eg. (3.5) shows 
that the transformed differential equation of the relling 
system has been reduced to its original non-rolling form. 
Note that all that was done in this compensation schere was 
to subtract the cross-coupling term from the command input 
to the nozzle actuator so than when it is added back on 
downstream the result will Fe no effective cross-channel 


terms into either ccntrol path. 


s2 0 8 |= ¡G(% - Kre se - 0) (4.3) 
0 s2 Y H (Yc ~ Krys¥ - Y) 
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Unfortunately, the problem is not as simple as Eq. (5.2) 
implies. The main problen is that the amount of control 
which can be used to force the system's response is limited 
by the maximum deflection angle of the exhaust nozzle. This 
nonlinear saturation of the actuator is not present in Eq. 


(4.2). Figure 4-2 summarizes the problen. 


i ae ee cee ee cg ee ee ee eee me us om emu ene QU CE rR RA oe Re 
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Fig. 4-2 Plant Dynamics and Control Input Limitations 
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Figure 4-2 shows that no matter what feedback scheme is 
employed to generate the pitch and yaw angular acceleration 
control signals, they are limited and, therefore, so is the 
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region of operaticn over which the performance of the system 
can be controlled and the degree of control possitle. 

Figure 4-3 shows the cross-coupling terms and the 
attempted cancellation of them by the cross-channel feedkack 
teras under the compensation schere just proposed. The 
simulation shown was performed during the first stage of 
operation with the system subject to a pitch-step command 
and a zero-yaw command. Note how the magnitude of the 
cross-channel feedback term is effectively saturated ky the 
nozzle actuator and cannot follow the cross-coupling tern 
outside a small region of operation. The sinulaticn was 
made by subtracting the error term generated by the differ- 
ence in command and feedback so that only the cross-channel 


feedback term is fed-through the nozzle actuator. 


B. NONLINEAR FEEDBACK 

Examination of Figs. 2-5, 2-9, 2-10 and 2-11 shows that 
the tine the nozzle actuator takes to reach uaximun deflec- 
tion when given a large input command {>> maximum deflec- 
tion) is insignificant (0.05 sec) when ccmpared to the 
settling time of the entire pitch-yaw contrcl system. Thus, 
the actuator is functioning almost like a switch in ail 
regions of operation except near the coamand input (steady 
state). For example, Fig.  !-4 shows the nozzle deflection 
in the pitch plane during a simulation when the system was 
subject to a pitch-step input and a roll rate of 2.5 
radians/second. The conclusicn to be drawn from Fig. 4-4 is 
that since the amplitude of the effective control input to 
the plant cannot be increased above saturation, the only 
alternative is to "throw the switch" a little sconer. 

The cross-channel feedback compensation schere just 
proposed will cause a reduction in the effective servo 
command and result in earlier removal of the maximum nozzle 
deflection (turning off the switch). However, this approach 
can at best only follow the cross-coupling terms and can not 
"anticipate" the need to switch the deflection angle from 
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positive maximum to negative maximum. Another method to 
accomplish the objective of switching the nozzle earlier is 
to vary the velocity feedback gains, Krg and Kry - 
Specifically, it is desired that the velocity feedback gains 
te low during the initial phases of operation when the error 
between command and position is large and increase as the 
system approaches the commanded value. This will result in 
the same basic system operation that was present tefore 
compensation {dominant complex-pair oscillation) but with 
low damping when the error is high and higher damping as the 
system approaches steady state. 

The nonlinearity of the system prevents the use of post 
analytical tools which might be used to determine algorithms 
for Kre and Kry - Instead, a trial and error approach was 
used based on the observations of the system's performance 
during earlier simulations and simulation studies performed 
specifically to determine appropriate parameters. 

Assume that the algorithm for determining the velocity 
feedback gain consists of a constant which is reduced Ey an 
amount proportional to the error between command and posi- 
tion. This will result in low damping if the error is high 
and increased damping as the error decreases. For example, 
if V and W are ccnstants, the pitch-channel velocity feed- 
back gain can be determined from: 

E oe No - el (4.4) 
Furthermore, the simulations shown in Figs. 3-13 through 
3-30 indicated that the system becomes more underdamped 
(roots migrate toward the iraginary axis) as the roll rate 
is increased. So, the velccity feedback gains were made 
proportional to the roll rate.  Normalizing the algorithm so 
that the relationship does not become zero if the rcll rate 


is zero yields Eqs. (4.5) and (5.6). 
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Angular Acceleration (rad/Sec*) 


0.15 


= (Y - v |0, - e|) t * p) (4.5) 


= (vs Yi) (d+) (4.6) 
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Fig. 4-3 Saturation of Cross-Channel Feedback 
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Fig. 4-4 Nozzle Deflection Angle Simulation 
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Figure 4-5 shows sample results of sinulation studies 
which were conducted for various values of V and W and cver 
various stages of operation and roll rates. The simulations 
showed that acceptable performance was obtained for V = 4 
and W = 3. 

Figures 4-6 through 4-14 show simulaticn results which 
were made by using the cross-channel feedback and variable 
velocity feedback gain compensation schemes together. For 
comparison, the uncompensated responses are also shown. The 
compensated simulation responses were obtained under the 
same operating conditions as those shown in Figs. 3-13 
through 3-30. 
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Fig. 4-6 Pitch-Step Response Roll Rate of 2.5 rad/sec 
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Fig. 4-7 Pitch-Step Response Roll Fate of 5.0 rad/sec 
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Fig. 4-9 Yaw-Step Response Roll Rate of 2.5 rad/sec 
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Fig. 4-10 Yaw-Step Response Roll Rate of 5.0 rad/sec 


83 


= 
ei 
> 
O 
© 
42 
a 
@ 
S 
0 
As 
E 
O 
O 
c 
Ə 


 Uncompensated Pitch 
_ Compensated Pitch 


_-Compensated Yaw 


91 


$0 
(SNVIAVA) ISNOASIA 


go- 





TIME (SEC) 


4-11 Yaw-Step Response Roll Rate of 7.5 rad/sec 


Fig. 


84 


. 
* 
. 


C 
O 
+ 
srd 
A 
O 
Y 
- +” 
0 
0 
E 
® 
or 
= 
^. 0 
O 
£f 
7 


-Compensated Pitch 


compensated Yaw 
, Compensated Yaw 





M [ 
(SNYId V3) ASN 


SOF OIF S812 00S 6/0 O'S. 0 Fc: 0'0 6 CO se VE SO COSS CS +0 cee e eee abeeS else ee c@eecceecieec 
. 


000000000000 + + 


wo a To- t- 
OdS3W 


80 
TIME (SEC) 


4-12 Pitch- 6 Yaw-Step Response Roll Bate 2.5 rad/sec 


Eige 


85 


p 
O 
42 
r4 
P 
TO 
ooo Qi) 
uo 
d 
UY 
S 
O 
a 
e EB 
O 
5 


Uncompensated Yaw 


Compensated Pitch 





400 


200 
TIME (SEC) 


Fig. 4-13 Pitch- 8 Yaw-Step Response Roll Rate 5.0 rad/sec 
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Ihe simulations indicate that substantial performance resto- 
ration is possible with the proposed compensation scheres. 
However, the restoration is not complete and is still much 
worse, in terms cf overshoot and settling time, than the 


non-rolling missile. 


87 


The compensation scheme proposed partially restores the 
pre-roll performance of the missile. Table 5-1 summarizes 
the level of perfcrmance degradation caused by roll and the 
restoration which was obtained with this compensation scheme 
under pitch- and yaw-step inputs and a roll rate of 2.5 
rad/sec. As indicated, the degradation is significant even 
at this relatively low (and stable) roll rate. The compen- 
sated system's performance is still far worse than that of 
the non-rolling systen. 

The compensation scheme relies primarily on the nonli- 
near damping effect of the variable velocity feedback gains 
which "anticipate" the approach of the commanded position. 
Since the cross-coupling terms introduced Ey roll are not 
directly cancelled by the proposed modification, the region 
of stable operation and the degree tc which the system's 
performance can te restored is directly controlled ty the 
roll rate. Furthermore, the saturation caused by the nozzle 
deflection will prevent any compensation scheme, which only 
modifies the ccntrol input, from fully restcring the 
system's performance. To completely restore the system to 
its pre-roll performance at any roll rate, additicnal 
control inputs to the system plant dynamics (such as, side 
thrusters or additional vectoring of the main rocket rotor) 


are necessary. 
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APPENDIX A 
NON-BOLLING MISSILE SIMULATION 


The DSL/360 program used to simulate the non-rolling 
missile is shown below. The program consists of three 
stages, initial, derivative and terminal. The initial 
segment is used to define constants and calculate functions 
of the constants which will net change throughout the simu- 
laticn run. The derivative section is where the actual 
integrations required to perform the Simulations are 
conducted. This program is constructed to follow the klock 
diagram of Fig. 2-1 directly. Note that the nozzle actuator 
transfer function was broken down into a three-step integra- 
tion. Ihe terminal stage determines the end condition of 
the simulation run and the output data. This data vas 
formed into a data file and a packaged graphics program 
(DISSELA) was used to construct the figures shown in the 
text. The parameter values listed in this example progran 


are those during stage one. 


+ INITIALIZE CONSTANTS 
CONST TST=7496000,L=363,31=11048.8,KTH=1.0,KB1IH=1.75,... 
Ñ 8A2150,WB-15,PB-0.9,RATE-930.0,11- 189140 
* COMPUTE SET VALUES 
INITIAL 
ONEZWHA* (WB**2) 
TWO=HA + 2*DE*WE 
: IHREE-2*PB*WB*WA * WB**Z 
* BEGIN SIMULATICN 
DERIVATIVE 
MASS-MI-BATE*TIME 
ECCM=STEP (0) 
* ERROR SIGNAL 
E=ECOM-P 
EL=E- (KRTH*E 1COT) 
CM=KTH*EI 
* SERVO TRANSFER FUNCTION 
SVO=INTGRL (0 Sy 1D01) 
SVIDOT=INTGBEL(0,SV2DOT 
SV2DOT=INTGRL (0, SV3DCT 
SV3DOT-ONE*(CM-SVO) - TWO*SV2DCT - THREE*SV1DOT 
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APPENDIX B 
ROLLING NISSILE SIBULATICN 


Unlike the non-rolling system simulations, the rolling 
missile simulations were required to run over several 
consecutive booster stages. This required the addition of a 
‘dynamic’! segment of simulation. The *IF* statements, shown 
in the example simulation below, are used to switch frog one 
set of parameters to ancther aS one stage burns off and 
another starts. The switching 1s controlled by the elapsed 
time of the simulation run compared to the turn time of each 


stage. 
* SET CONSTANTS 
CCNST KTH=1.0,KRTH=1.5,WA=150,NB=15,PB=0.9,RCLIL=7.5 
* INITIALIZE SET VALUES 
INITIAL 
A = NAT IRE ol 
B = WA + Z*EB*WE 
C - 2*PE*WB*WAÀ * WB**2 
HESET=0.0 
*INITIALIZE FIRST STAGE VALUES 
TST-7496000 
1-363 
J1211048.8 
J27 136.1 
FATF=930.0 
N M1=189140 
* DECIDE WHICH STAGE OF FLIGHT 
DYNAMIC 
* ENTER STAGE TWO 
IF (TIME.L1.150) GO TC 10 
TST=1125000 
L = 230 
J1=4476.4 
RATE=81.49 
M1=40340 
RESET=150 
* ENTER STAGE THREE 
IF (TIME.LI.509) GO IC 10 
TST=224900 
L=100 . 
J1=858. 3 
J2=50.0 
RATE=14.75 
M1=8140 
RESET=509 
10 CONTINUE 
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